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(54) Verfahren zur fetilertoleranten Positionsennlttlung eines Objelcts 

(57) Zu Auswertezeitpunklen (t|) werden von meh- 
reran Sensoren (S1..Sn) individuelle Positionsangaben 
(P1...Pn) individueller GQte bereitgestellt. Die individu- 
ellen Positionsangaben werden nach sensorzugeordne- 
ten Wichtungsfaktoren gewichtet zur Ermittlung jeweiis 
einer auswertezeitpunktaktuellen Objektposition (OP) 
verwendet. Unter Berucksicirtigung der Objektdynamik 
werden ausgehend von den Positionsangaben sensor- 
individuell fur den nSchsten Auswertezeitpunkt (tj+i) 
Objektpositionsschatzungen vorgenommen. Durch 
nachfolgende Auswertung der Qualitat der Objektposlti- 
onsschatzung werden die Widitungslaktoren fortlau- 
fend der jeweiligen PositionsangabengOte enlspre- 
chend erhOht oder erniedrigt. 
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Beschrefbung 



Die Erf indung liegt auf dem Gebiet der Ortung und Positionsermittlung. insbesondere der autarken Pdsitionsermitt- 
lung, von bewegten Objekten und insbesondere von Verkehrsmitteln. 

5 Im Berelch der Luftfahrt und des Individuatverkehrs hat sich das ^Global Position System" (GPS) als Navigations- 
hilfe durchgesetzt. Es ermOglicht auch be! ungunstigen Wrtterungsbedingungen eine hochgenaue Positionsermittiung. 
Allerdings kOnnen Abschattungen z.B. in Hfluserschluchten oder in einem langeren Tunnel zu Positionsdatenveiiusten 
fOhren. Das ursprOnglich fOr militarische entwickelte GPS wird bei der ziviien Nutzung mit einem StOrcode uberlagert, 
so daB mit reduzierter Genauigkeit gearbeitet werden mu6. Diese Aspekte fuhren u.a zu einer bislang mangelnden 

10 Akzeptanz gegenaber GPS bei dem spezielle sicherheitstechnische Anfbrderungen stellenden Schienenverkehr. 

Daher ist eine Kombination des GPS mit anderen, bewShrten Positionssensoren, wie z.B. Odometer, Achszaiiler, 
Baken. TrSgheisplattformen oder Radarsensoren. zur Bildung von Mehrfechsensorsystemen enwfigenswert. 

Derzeit werden derartige Mehrfachsensorsysteme meist ledigllch wie (mehrfach) redundant ausgelegte Einzelsy- 
steme behandett Eine Optimierung der Positionsermittiung mit synergistischer Leistungssteigerung ist dagegen noch 

15 nicht bekannt geworden. 

AuBerdem erfolgt die SIgnalverarbeitung von Mehrfachsystemen bisher nur durch eine einzige Zuslandsschatzung 
(vgl. z.B. Baumker, „DGPS-gestOtztes Fahrzeugnavigationssystem mit faseroptischen Kreiseln", Zeitschrift fOr sateili- 
tengestutzte Positionierung, Navigation und Kommunikation, 12/95, Wichmann Verlag) in einem mehrdimensionalen 
Zustandsraum. so daB ein zeitlich multimodales Verhatten des Systems nicht volistdndig erfaBt werden kann. 

20 Die Aufgabe der Erf indung besteht in der Schaffung eines Verfahrens der eingangs genannten Art, das unter syn- 
ergistischer und kombinatorischer Auswertung mehrerer sensorindividueller Ortsangaben eine optimierte Objektpositi- 
onsbestimmung ermOglicht. 

Diese Aufgabe wird erfindungsgemSB durch die in den PatentansprQchen 1 und 2 angegebenen Verfahren gelOst. 

In ublicher Ortungstechnik werden die MeBgrOBen der einzelnen Ortungssensoren (z.B. Wegldnge/Odometer; 
25 GPS) getrennt erfaBt und stehen nach MeBwertaufbereitung als individuelle Positionsangaben zur VerfOgung. AuBer- 
dem werden statistische Angaben uber die Sensoren - wie Drift- und Diff usion&A/erte • (Varianzen) bereitgesteitt, die im 
einfachsten Fal) Datenbldttern als konstante GrOBen entnommen werden kOnnen. Die individuetlen Positionsangaben 
und statistischen Angaben eines Sensors werden nachfblgend als (sensorlndividuelle) „sensorische Infbrmationen" 
bezeichnet. 

30 Ein erster Vorteil der erf IndungsgerndBen Verfahren besteht darin. daB durch Vergleich der jeweiligen auswerte- 
zeitpunktaktuell ermittelten Objektpositionen mit der Vorhersage (Pradiktion) zum vorhergehenden Auswerteze'rtpunkt 
und durch permanenten Vergleich der Sensoren untereinander die MeBgute jedes einzelnen Sensors koninuierlich 
erfaBt wird (permanente autarke GOte-B^ertung). Dadurch lassen sich unbrauchbar schlechte Positionsangaben 
automatisch ausfiltern. Diese vorteilhafte Verlahrenseigenschaft basiert auf dem erfindungsgemdBen Einsatz global 

35 approximierender (nichtiinearer) Optimalfilter und stellt einen wesentiichen Aspekt der Erf indung dar. 

Ein weiterer wesentiicher Vorteil der Erfindung besteht darin. daB sensorartbedingte, aber auch vorubergehende 
Oder langzeittypische Verschlechterungen der Sensorgute bei der Ermittlung der Objektposition addquat berOcksichtigt 
werden. 

Die erfindungsgemdBen Verfahren venverten jede Sensorinformation und sind hinsichtiich Anzahl, Art und Qualitat 
40 der eingesetzten Sensoren offen. Dadurch kOnnen fQr jeden unterschiedlichen Einsatzlall spezifisch angepaBte Sen- 
sorsysteme eingesetzt. bedarfsweise ausgetauscht oder ergdnzt werden. Die fehtertolerante, redundante Auslegung 
erfolgt autark. Fehlerberechnungen mittels aufwendiger experimenteller Analysen entfallen. Ebenso kann auf Klassifi- 
kationskriterien verzichtet werden, die einen Sensor ats fehlerhaft einstufen. 

Vorteilhaftenveise kOnnen mehrere preiswerte Sensoren verwendet werden und dennoch - statistisch uber einen 
45 langeren Zeitraum betrachtet - Ortsinfbrmationen von besserer Gate als ein einziger hochwertiger (und damit teurer) 
Sensor erzeugen. 

Eine verfahrenstechnisch bevorzugte RealisierungsmOglichkeit des erfindungsgemaBen Verfahrens ist in 
Anspruch 3 angegeben. 

Bei der Verfahrensdurchfuhrung kann die Anzahl der zu verarbeitenden Werte (Filterdichtoi) mit der Zahl der Abt- 
50 astschritte erheblich zunehmen. Eine in dieser Hinsicht bevorzugte Ausgestaltung des erfindungsgemdBen Verfahrens 
sieht vor, daB der Werteumlang der Rtterdichte vor ihrer anschlieBenden Venwendung als Prddiktionsdichte reduzlert 
wird. 

Die Erfindung wird nachfblgend anhand einer Zeichnung beispielhaft waiter erldutert; es zeigen: 



55 Rgur 1 ein Sensorsystem mit Verarbeitungseinrichtung, 

Figur 2 zeitliche Drift und Diffusion eines bewegten Objekts, 

Rgur 3 das Ergebnis einer Optimatfilterung, 

Rgur 4 die Bildung einer MeBdichte aus den Informationen mehrerer Sensoren, 
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Figur 5 das Prinzip einer DichtenreduWion urxJ 

Rgur 6 eine zusammenfassende Darstellung des Verfahrens. 

GemdB Figur 1 basiert das erf indungsgemaBe Veriahren auf der Auswertung individueller sensorischer Informatio- 
5 nen II. ..In von n Sensoren SI bis Sn. Diese stellen MelSwerte (Positionsangaben) P1 bis Pn zur Ortsermittlung und 
sensorlndividuelle slatistische Angaben a1...on uber Ihre Gute bereit (zusammenfassend als sensorische Information 
nen II... In bezeichnet). Die Sensoren kOnnen z.B. als GPS, CXJometer, Ballise, Gyro, Radar-/ Laser-Detektor etc. rea- 
lisiert sein. Die sensorindividuellen Positionsangaben weisen In Abhangigkeit von der SensorgOte unterschiedliche 
Zuveriassigkeiten auf, so daB sich statistische Wahrscheinlichkeiten bzw Wahrscheinlichkeitsdichten fur die jeweilige 
10 Position ergeben; diese werden nachfblgend auch als .EinzelmeBdichten" bezeichnet. Die Individuellen Positionsanga- 
ben werden einer Verarbeitungseinrichtung (Multlpositionsserver) MS zur Auswertung und weiteren Verarbeitung zuge- 
fOhrt, Wie nachfolgend nfiher eriautert, stellt die Verarbeitungseinrichtung MS ausgangsseitig die jeweils aktuelle 
Objektposition OP bereit. die beispielsweise zur Anzeige gebracht. einem Bordcomputer BC zugefQhrt Oder als Kbrrek- 
tursignal KS zur NachfQhrung (ifxjate) einzelner Sensoren venwendet werden kann. 
IS Einf Qhrend soil zum ieichteren Verstandnis zunachst nur der Fall eines einztgen Sensors (uninnodaler Fall) behan- 
dett werden. Das zu ortende, dynamische System (z.B. ein fahrender Zug) wird durch ein Systemmodell und das Sen- 
sorsystem durch ein MeBmodell beschrieben. 

Fur den zu schatzenden Ort bzw. den ein- oder zweidimensionalen Zustandsvektorf ergibt sich zwischen zwei infi- 
nitesimaien Abtastschritten (nachfolgend Auswertezeitpunkte genannt) die elementare Markov-Beziehung: 

20 

f(ti + At) = f(ti)+As f; + ©(At); mit At^l^^-t,, l,<t,^, (1) 



Dabei ist: 

Zeitpunkt, zu dem die nachste sensorische Information eintrifft (nachster AuswertezeHpunkt) 
t A Einheitsvektor in Richtung der inkrementalen Fahrwegtrajektorie 

30 

(f(ti + At)-f(t,)) 



35 

As = V • At Wegiangenelement (Produkt von Objektgeschwindigkeit v und Zeitraum At zwischen zwei Abtastzeit- 
punkten 

d (At) Summe der wahrend At auftretenden stochastischen Fehler (Rauschen). Der Enwartungswert von d ist 
Null: 

40 

(co(At)) = 0 



Das Rauschen co(At) in Gleichung (1) stelit die Gesamtheit ailer auf das Fahrzeug im Zeitraum At einwirkenden 
stochastischen Einflusse dar (z.B. statistische Fehler der Sensor-. Navigations- und Anzeigesysteme, EinflOsse im 
Rad-FahPAfeg-Kontakt und aerodynamische EinflQsse). Bildet man in Gleichung (1) das Scharmittel (...>Qber alle 
Musterfunktionen von {(5 (At)}, so erhatt man: 

(f(ti+At)) = {f(ti))+(Ar(At)) mit <Ar(At)):= (As)?; (2) 



Man kann d als gauBsches weiBes Rauschen ansetzen mit: 
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{(co(ti) w^(tj))^=Q[ti) d5 und Q: Kovarianzmatrix des Rauschens (3) 



Damit kdnnen System (Glelchung 2) und Messung durch gauBsche Wkhrscheinlichkeits-Verteilungsdlchten 
(Aufenthaltswahrscheinlichkeitsdichten) beschrieben werden. die vollstandig durch Erwartungswert bzw. 1. Moment 
und Kovarianz (-Matrix) bzw. 2. Moment charakterisiert sind. 
10 Die zeitliche Evolution der Systemdichte ist durch Drift, d.h. durch die Bewegung des Envartungswertes. also des 
Objekts seibst. und Diffusion, d.h. VergrOBerung der Varianz mit der Zeit - enlsprechend der Abnahme der Lokalisie- 
rungsschdrfe - gegeben. 

Die sich vom aktuellen Auswertezeitpunkt tj bis zum ndchsten Auswertezeltpunkt tj^^ ohne Berucksichtigung der 
Messung entwickelnde Systemdichte wird nachfolgend Prddiktionsdichte pp genannt (vgl. V. Krebs. ^Nichtilneare Fitte- 
rs rung, Oldenbourg Verlag, Munchen 1980). 



20 



(4) 



T: Transponentiation 
25 < r )p Enwartungswert (1 .Moment) von pp( t ,t) 
P Kovarianzmatrix (2.Moment) von pp(t ,t) 

Die zeitlk^he Verdnderung von (f >p entspricht der Eigenbewegung des Systems, vgl. auch Gleichung (2): 

(r>p(t + At) = (r)p(t)+{Af(At)), mit (Ar(Al)) : Driftanteil, (5) 
« (T)p(tu,) = (T>p(t|) + (Ar(t,,,-t,)) , lM-t,=At 



35 



40 



Die Kovarianzmatrix P ist ein MaB fOr die zeitliche Formverdnderung der Dichte pp( t .t) - d.h. der Verbreiterung und 
Abf lachung entsprechend der Abnahme der Informations- bzw. Lokalisierungsschdrfe Oder Verengung und ErhOhung 
entsprechend der Zunahme der Informations- bzw. Lokalisierungsscharfe - mit 

p(f,t)=8(f,t) 



als Grenzfall: 



45 



P(t+At) = P(t) + Q(At) 



(6a} 



so mit g als Kovarianzmatrix des gauBschen Systemrauschens ^ , vgl. auch Gleichung (3). 
Beispielhaft ergibt sich fQr Q Im zweidimensionalen Fall: 



55 



<j'(At)=DyAt, 



(6b) 
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Djj : Diffussionskonstanten 

Im eindimensionaten Fall Kann a(M)^/^X angesetzt werden, wobei D & const (Dimension: 'LSngenquadrat/Zeit') 
sich ausdem Diffusionsverhalten des Gesamtsystems (Rgur 1) bestimmt und Qber einen Vorgabewert festzulegen ist. 
5 Ist Z.B. einer der Sensoren ein Inertia! Navigation System (Gyro), so Kann n^ deren Diffusionswerten gemdB Datenblatt 
gerechnet und die Vereinfachung D^^sD22^cr^^Ba22 und ai2^2i"0 (verschwindende Kreuzkovaiianzen) vorge- 
nommen werden. 

Das Drift- und Diffusionsvertialten der Systemdichte veranschaulicht Rgur 2. 

Im unimodalen Fall Ist nur ein einziger Sensor und damit nur sine anzige MeBdichte vorhanden: 



Die Momente < r >m und R bestimmen sich aus der sensorischen Information, die der Sensor zum Zeitpunkl t zur 
Verfugung stellt, wobei die Komponenten des Enwartungswertes (t )m den Ortsanteil (ein- Oder zweidimensional) und 
20 die Komponenten der MeB-Kovarianzmatrix R den statistischen Anteil der sensorischen Information bilden. R ats Kbva* 
rianzmatrix des MeBrauschens wird in gleicher Weise wie Skonstrulert (analog Gleichung (6b)). 

Zur werteren Erlduterung wird davon ausgegangen, daB zum Auswertezeitpunkt t^t, die bestimmenden Werte von 
System und Messung vorliegen, also die Dichten gemaB Gleichung (5) bis (7) ermlttelbar sind. Das Produkt aus gauB- 
scher System- und MeBdichte (Bayessche Regel) zu diesem Auswertezeitpunkt t^t , ist dann ebenfalls eine gauBsche 
25 Dichte, die nachfolgend als Rlterdichte ppii bezeichnet wird, deren erstes und zweites Moment mit den KalmanfiKer- 
Gleichungen identisch ist: 



10 




(7) 



15 



30 



pH,(r.l) = cpp(f,t)PM(f.t)= 



4ie 




(8) 



dabei ist c ein Normierungsfalctor, der dafOr sorgt, daB gilt: 



35 



Jlp«aOd'r = l 



40 (Nomiierung der gauBschen Dichte). 

Kbeffizientenvergleich von linker und rechter Serte In Gleichung (8) ergibt: 



(f>B :=a(t)+PH r(t) (0)M(t)-(i)p(t)) 



45 



[1 . Moment von ppji zum Auswertezeitpunkt t] 



50 



EFii>(£''(t)+B\t)) 



•1 



[2. Moment von ppj| zum Auswertezeitpunkt t] 



55 



7-=(<r)M(0--{f)p(t)f-rfra S''W additiver Eichterm (9) 
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Mit EinflieBen der Messung zum Zertpunkt t=t, wind also aus der PrSdiktionsdichle pp (fie Rlterdichte ppii. welche 
im nachsten Zeitschritt - vom Auswertezeltpunkt tj auf den Auswertezeitpunkt X=X^^ • als neue PrSdiktionsdlchle fun- 
giert. Der Erwartungswert < r )Fi) ist der neue optimierte Schdtzort, d.h. die nunmehr aktuell neu ermittelte O^ektposi- 
tion. Dieser Sachverhalt ist In Figur 3 schematisch dargestelit 

5 Der Erwartungswert ( r zeichnet sich durch die niinimale Varianz des Schatzfehlers aus; Figur 3 zeigt dies durch 
die Schlankheit der FIHerdichte pr}. Die Ausdrucl<e fOr <f >fd und Ppp in Gleichung (9) korrespondieren mit den Wassi- 
scl^en Kalniarrfiltergleichungen. Letztere liefern jedoch keine Infornfiationen Qber RItenvichtungen urxi sind daher im 
multimodalen Fall nicht braucht>ar 

Derartige Wlchtungen werden dagegen beim erf indungsgemfiBen Verfahren vorteilhaftenweise durch die mit dem 

10 Term y in Gleichung (9) bezeichneten GrOBen vorgenonftmen; dies stellt einen ganz wesentlichen Aspekt des erfin- 
dungsgemdBen Verfahrens dar. 

Nachfolgend wird zur Eriduterung des Verfahrens bei Einsatz mehrerer verschiedener Sensoren Bezug wieder auf 
die Figur 1 und auf Rgur 4 genommen. die das Sensorsystem darsteilen. GemdB Rgur 4 ist bei mehreren Sensoren 
Si bis Sn (multimodate MeBwertverart)eitung) die MeBdichte p^ die Summe aus (n) EinzelmeBdichten p^J^, 1=1 ...n. die 

IS verfahrensgemaB mit der Prddiktionsdichte pp gemdB Gleichung (8) kombiniert wird: 
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(10) 



Dabei kann wegen der relativ geringen Geschwindigkeiten insbesondere des landgestutzten Verkehrs davon aus- 
25 gegangen werden, daB zum Zeitpunkt t alle sensorindividuellen Positionsangaben vorllegen. Die genaue Festlegung 
der Abtastrate (zeitlicher Abstand der Auswertezertpunkte) bestimmt sich aus der niedrigsten und hOchsten Abtastfre- 
quenz der jeweiligen Sensoren sowie der Rechentotzert. 

Mit den Gleichungen (8) und (10) ist die Rlterdichte pni ebenfalls eine Summe entsprechender EInzetfllterdichten. 
Diese Summen-Filterdichte ubernimmt beim Ubergang auf den nachsten Zeitschritt die Rolle der Prddiktionsdichte pp^ 
zo so daB auch pp eine Summe entsprechender Einzeldichten ist: 

Pp(f.t)=ip,ntt), 

55 

Ppnf.t)=-^exp[-i.(r-(r>«^^^^^^ (11) 



wobei Wj Wichtungsfaktoren sind mit 



:1. 



>»1 

Allgemein erhdit man damit zu einem beliebigen Auswertezeitpunkt: 



mit den Momenten 
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5 

[1. Moment von ppg zum Auswertezeitpunkt f] und 

P^;il?:=(£<J(t)+R"(J{t))'' 
[2. Moment von ppg zum Auswertezeitpunkt f\ sowie den Wichtungsfaktoren 

«. = ^ . ■ , «p {-5 «c -«?)' K c s;; (ws -<»>?)} 



20 Die Momente < t ) *^ und der Einzelfitterdichten werden also analog Gleichung (8) und (9) berechnet. Die 
Summenindices 1 und j mussen nicht notwendig gleich sein. Nach Berechnung von < f ) und P fur alle Kombina- 
tionen (ij) kann die Doppelsumme in Gleichung (12) als normierte Einfachsumme uber einen Mitlauf index I ausge- 
drOckt werden: 



25 



p»(^t)=c.i^.«{-i.(f-(ry»)'.pS-'.(f-<-r)!i)] 



(13) 



30 

mit(i.D^ 
und 



w,- 



05 norm, 



mit 

40 



£wr"'=1 
I 



45 Damit ergibt sich fOr die aktuelle Objeklposition: 



<f).==Iwr(?>™ ,.4, 



SO 



FQr die zugehOrige Gesamtkovarianzmatrlx Egeg ergibt sich mit Gleichung (14): 

55 
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Der aus Gleichung (15) bestimmbare skalare Wert iPgesI^ IR steitt ein ReferenzmaB fQr die RItergQte dan 
Zur Ableitung der Gleichungen (14) und (15) soil noch fotgendes ergdnzt werden: 
10 Setzt man 

p(r)=Iw,AT) 

I 

IS 

als Summendichte gemdG Gleichung (13) in die allgemeinen Emvartungswert-Definitionen (siehe u.a. Bronstein, 
Jaschenbuch der Mathematik") 



^ (1) (f):=}}fp(f)d^r 

m m 

25 

ein, ergeben sich nach Anwendung der Enwartungswert-Rechenregein die Gleichung (14) und (15) unmittelbar. 

Weil die Wichtungsfaktoren wy von den Residuen der MeBinforniationen (Sensoren) bestimmt werden, erhatten die 
Sensorsignale urn so stdrkes bzw. geringereres Gewicht. je besser bzw. schlechter die Me3gute ist. Das systemimma- 
30 nente MaB diese MeBgOte bestimmt sich einerseits aus dem mit der MeBhistorie behafteten Vergleich der MeBinlbrma- 
tion mit der Systeminformation (iteratives Procedere der Multimodalf ilterung) und andererserts aus dem Vergleich der 
Sensorinformationen untereinander (systemimmanente Wichtungen). 

Die Gleichungen (12) und (13) stellen einen Parallelbetrieb ebensovieler Kalmanfilter dar, wie Terme in der gauB- 
schen Doppelsumme vorhanden sind. Wie Gleichung (12) zeigt, nimmt die Zahl der Fiiterdichten exponentiell mit der 
35 Zahl der Abtastschritte zu. Damit wird das vollstdndige Wtssen der statistischen Evolution zum Ausdruck gebracht. was 
einen wesentlichen Vorteil des erfindungsgemdBen Verfahrens ausmacht. tm Hinblick auf die praktische Realisierung 
mit vergleichsweise leistungsschwachen Hardware-Komponenten ist eine Fiiterdichten- Reduktion vorteilhaft. Diese 
kann wie nachfolgend ertdutert zweistuf ig durchgefDhrt werden. 

Im 3a-Bereich tiegen mit 99.6%-iger Wahrscheinlichkeit die Werte einer normalverteiiten Zufallsvariablen; diese 
40 sind bei zweidimensionalen gauBschen Dichten von der sog. 3a-Ellipse umschlossen. Dementsprechend stellen Werte 
auBerhalb dieses Bereichs dreifacher Streuung (a^ = Varianz) keine venwertbare Information mehr dar. Daher werden 
In einer ersten Stufe zur Fllterdichten-Reduktion Einzel-PrSdiktionsdichten eliminiert. innerhalb deren 3a-Grenzen 
keine Positionsangaben (Sensonwerte) tiegen. 

Eine zweite effektive und besonders bevorzugte Reduktionsstufe wird nachfolgend ausgehend von einer Gleichung 
45 (12) bzw. (13) entsprechenden Summe von n-normierten gauBschen Dichten eriautert: 



p(f)=twiP'"(f) (16) 



50 

mit 



n 

55 £w,«i: 

und den Gesamtmomenten <? ) und P (gemdB Gleichung (14) und (15)). 
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Die Dichte p(t) in (16) soil durch eine Dichte p(f ) mit einer geringeren Anzahl fi gauBscher Summanden appro- 
xlmiert werden: 



mit l^n^n und den Qesamtmomenten ( f ) und P . Da das Variationsprobiem 

10 

m m 



A^:=JJ|p(r)-p(f)fd*r->0 



15 nicht geschlossen lOsbar ist unter der Nebenbedingung. daB die Nonnierung und die Gesamtniomente erhalten bleiben 
gemdB 



20 

und 



P = P 

25 as ■ 



(vgl. H. W. Sorenson; D. L. Alspach. ^Recursive Bayesian estimation using Gauslan sums", IEEE Trans, on Automative 
Control, 1972). werden schrittweise immer di^enigen Summanden yN^*p^Xt) und W| • p^^(t) der Dichte p(f ) aus Glei- 
Chung (16) zu einer resultierenden Dichte wi^ • p^-')( ?) zusammengefaBt, fur die der Approximationsfehler 

30 

K - n (w«p" "(?) - (w,p'"(f ) + w,p<"(r))yd'r ( 18 ) 

35 

minimal ist. Dies ist in Figur 5 schematisch dargestellt. 
Gleichung (18) ist im einzelnen wie folgt ablertbar: 

40 ^" •= n {w„p''''(r)-(w.p''rr)+ w.p'Tr))}' d'r = 

= n(w.p'"(f)yd'r + n(w.p"'(f)yd'r + Jj(w„p<-(f)yd'r - 

« - 2nw,p'»>(r)-w„p'"'(nd'r - 2 j jw, p<"(f ) • w„ p""(r) d'r + 

+ 2 j jw,p"'(f) w,p">(f) d'r 



50 



55 



Das Fehlerintegral besteht somit aus 6 Summanden des Typs 

J J p%®d^mit 
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0) (D^r 00 (0 

Diese Integrale zweier normierter gauBscher Dichten le^en sich elemerrtar bestimmen zu : 

• CO .00 ' ^ 

(Bronstein. Jaschenbuch der MathematilO) nfvt: 

10 

Bedingung fOr und p^'^ ist auch hier, daB Normierung und Gesarntmomente der ganzen Summe p(f ) erhalten 
bleiben. Diese Bedingungen sind erfuIK mit 

(ry^^^.J.(w,(f)C^>^w.(rr) (19, 

25 ^tl 

30 

Den Gleichungssatz (19) erhdtt man mit n=2 unmitteibar aus den Gleichungen (14); (15). Es laOt sich dazu leicht 
zeigen, daB der resultierende Erwartungswert (f ) und die resuttierende Kovarianzmatrix gnach BQndetung eines Paa- 
res belieblger Summanden p^). p(^ kH, der Summendichte p (Gl. 16) unverdndert bleiben. 
35 Die Reduktion von n- auf n-Summenglieder eriblgt durch wiederholte PaarbQndelung (Figur 5). Die zu bflndelnden 
Dichtenpaare werden also durch eine resultierende Dichte mtt den unter Gleichung (19) aufgefOhrten Momenten 
ersetzt 

Der Approximationsfehler Ai^ braucht dabei fur Paare. bei denen beide Partner an den bis dahin eriblgten Bunde- 
lungen noch nicht beteiligt waren, natOrlich nicht erneut berechnet zu werden. Bevorzugt sollte die Summandenzahl der 

40 Prddiktionsdichte etwa der Anzahl der Sensoren. d.h. der Summandenzahl der MeBdichte (Figur 4) entsprechen. 

AbschlieBend wird unter Bezugnahme auf Rgur 6 das Verfahren im Zusammenhang dargestellt. Die von den ein- 
zelnen Sensoren SI bis Sn gelieferten individuellen Positionsangaben PI bis Pn werden zu bestimmten Auswertezeit- 
punkten unter Bildung einer SummenmeBdichte pm (vgl. Figur 4) zusammengefaBt (MeBmodell). Unter 
BerOcksichtigung der Dynamikdes bewegten Objekts OBJ wird von der zum aktuelten Auswertezeitpunkt ermittelten 

45 Objektposition ausgehend zumindest eine Prddiktionsdichte pp erzeugt. die ^ne Objeklpositionsschatzung fQr den 
nach dem aktuellen derzeitigen Auswertezeitpunkt fblgenden (ndchsten) Auswertezeitpunkt und deren Schdtzungsgute 
reprdsentiert. Die im nachsten Auswertezeitpunkt gebildete SummenmeBdichte pm wird mit dieser Prddiktionsdichte pp 
zur Bildung einer Filterdichte ppn muttiplikativ verknQpft (Multimodatfilterung). Der resultierende EnA/artungswert der 
Ortsposition <r)ges wird als aktuelle (Dbjektposition ermittelt und z.B. zur Weiterveraibeitung einem Navigationsmodul 

so Oder zur Anzeige bereitgestein. Nach Durchfuhrung der zuvor beschriebenen Dichtenreduktion wird die reduzierte Fil- 
terdichte fOr den ndchstfolgenden Auswertezeitpunkt als neue Prddiktionsdichte pp venvendet 

Mit dem erfindungsgemdBen Verfahren wird jede Sensorlnformation optimal verwertet. Das Verfahren ist fOr 
Anzahl und Art der eingesetzten Sensoren often, so daB fur unterschiediiche Einsatzfdlle auf verschiedene Sensorsy- 
steme zurQckgegrrffen werden kann und diese bei Bedart ausgetauscht Oder ergdnzt werden kOnnen. 

55 Die Problematik der fehlertoleranten, redundanten Auslegung wird verfahrensmdBig autark gelOst. Fehlerberech- 
nungen unter BerOcksichtigung aufwendiger experimenteller Analysen entfallen. Et>enso entfallen die nicht unproble- 
m^tischen Klassif ikationskriterien. ab wann ein Sensor als fehlerhaft gilt. Hierzu ist anzumerken. daB ein Sensor In der 
Regel nicht so spontan ausfdilt, daB dies an den Ausgabesignalen signif ikant erkannt werden kann. Auch kann der 
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durchaus nicht untypische Fall eintreten. da(3 ein Sensor vorObergehend schle<^e Werte produziert und dann wieder 
normal arbeitet, also zeitabhSngig von StOrungen beaufschlagt 1st. EIn Vorteil dieses Verfehrens 1st. solche Informati- 
onseinbrOche auszuf iftern und damit stets das Optimum der korreklen Information bereitzustellen. In den von der indi- 
viduellen Leistungsfdhigkeit und Zuveriassigkeit der einzeinen Sensoren - gemessen an der als Referenz dienenden 
GesamtgOte der PDsitionsermitttung ■ bestirrunten WIchtungsfaktoren spiegelt stch dessen Individueller Beitrag an kOnf- 
tlgen Posrtionsermittlungen wieder. Hat ein SensormeBwert zu einer uberdurchschnittlichen PradikBon der zukunftigen 
Objektposition gefOhrt, erhait dieser Sensor quasi einen Bonus dadurch, dal3 sein Wichtungsfaklor entsprechend 
gegenuber den anderen Sensoren heraufgesetzt wird. Die Positionsangabe dieses Sensors ertialt damit fur die zukunf- 
tige Positionsermitttung ein grOBeres Gewicht Entsprechend wird der Wichtungsfaktor eines Sensors reduziert (Malus) 
und damit dessen zukOnftiger Beitrag zur Ernnittlung zukQnftiger Objektpositionen vernrtindert wenn die auf s^ner Posi- 
tionsangabe beruhende Prddiktion unterdurchschntttlich war. 

PatentansprOche 

1 . Verfahren zur fehlertoleranten Positionsermitttung eines Objekls. 

bei dem sensorische Informationen (II. ..In) bereitgesteitt werden, die zu bestimmten Auswertezeitpunkten (tj) 
von verschiedenen Sensoren (S1 ...Sn) gelieferte individuelle Positionsngaben (P1...Pn) individueller GOte und 
sensorindividuelle statistische Angaben (a1... on) uber die Qute umfassen, 

bei dem die sensorischen Informationen (II. ..In) nach sensorzugeordneten Wichtungen (wjj) gewichtet zur 
Ermittlung jeweits einer auswertezeitpunktaktuellen Objektposition (OP) vennrendet werden, 
bei dem zum jeweils aktuellen Auswertezeitpunki (ti) unter Berucksichtigung der Objektdynamik von den sen- 
sorindividuellen sensorischen Informationen (II. ..In) ausgehend fOr den nachsten Auwertezeitpunkt (Xu.^) 
Objektpositionsschatzungen vorgenommen werden, 

bei dem die sensoridivlduellen Objektpositionsschatzungen mit der nunmehr im nachsten Auswertezettpunkt 
(tj+i) aktueil ermittelten Objektposition (OP) verglichen werden und bei dem jeweils die Wichtungen (W|p for 
diejenigen Sensoren (S1...Sn), deren sensorische Informationen (11 ...In) zu einer hohen Schdtzqualitat gefuhrt 
haben, gegenOber den Wichtungen (Wjj) der anderen Sensoren (S1 ...Sn) ertiOht werden, 
wobei die Schatzqualitat zumindest umso hOher eingestuft wird, je naher die Objektpositionsschatzung des 
aktuellen Auswertezeitpunkts (t|) an der im nachsten Auswertezeitpunki (tj^i) ermittelten Objektposition (OP) 
liegt und je gerlnger die Varianz der Objektpositionsschatzung ist. 

2. Ver^en zur fehlertoleranten Positionsermitttung eines Objekts. 

bei dem zu bestimmten Auswertezeitpunkten (tj) von mehreren Sensoren (S1...Sn) EinzelmeBdichten (pi^) 
geliefert werden, die jeweils eine Positionsangabe (P1...Pn) mit sensorindividueller Gute reprasentieren, bei 
dem die Einzelme3dichten unter Bildung einer SummenmeBdichte (pm) summiert werden, 
bei dem zu einem aktuellen Auswertezeitpunki (tj) unter Berucksichtigung der Objektdynamik zumindest eine 
Pradiktionsdichte (pp) erzeugt wird, die eine Objektpositionsschatzung fOr den nachsten Auswertezeitpunki 
(tj^.^ und deren SchatzungsgOte reprasentiert, 

bei dem die im nachsten Auswertezeitpunki (1^^^) gebildete SummenmeBdichte (p^) mit der Pradiktionsdichte 
(pp) des vorhergehenden Auswertezeitpunkts (tj) zur Bildung einer RHerdichte (ppii) multiplikativ verknQpft 
wird, 

bei dem aus der Filterdichte (pp,|) die aklueile Ot3jeklposition (OP) ermittelt wird und 

bei dem die Filterdichte (ppn) als Pradiktionsdichte (pp) fOr den nachslfblgenden Auswertezeitpunki venwertet 

wird. 

3. Verfahren nach Anspruch 2, 
gekennzeichnet durch 

fblgende Bildungsvorschriften fOr die: 

a) SummenmeBdichte 



Nl 
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b) Prddiktionsdichte 



Pp(r.t) =£ppnf,t), 



p,«>(r,t)=-i=.exp[4.(r-(f);»(t))^p-^^^^ 

2«)||E(i,| ^ 

wobei jeweils: 

T: Transponentiation 

t: beliebiger Auswertezeilpunkt 

( r ) B (t) Erwartungswerl (1 . Moment) der i-ten Einzel-MeBdichte pm^H r .t) 
< r ) i!) (t) Erwartungswert (1 . Moment) der j-ten Einzel-Prddiktionsdichte pp^{t .t) 
R(j)(t): Kovarianzmatrix {2.Moment) von Pw^'^Ct ,t) 
P^Ct): Kovarianzmatrix (2.Moment) von pp^^t .t) 



wi: 



Wichtungsfaktoren mit 



hi 



c) der Filterdichte 
Pni 



=c•[iPM4^IPp''^]=c•2^,•exp^-i.(f-(Ty^>)^r^^^^^ 



mitdenMomenten: 

(C := (D?(o +p'^£;(t)((f>:(t)-(T>?(t)) 

[1 . Moment von ppj} zum Auswertezeitpunkt t] 

und 

E^;^:=(£;S(tHftJ(t))-^ 

[2. Moment von pp,| zum Auswertezeitpunlct t] sowie 
den Wichtungslaktoren 
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W, 
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10 4. Verlahren nach Anspruch 2 Oder 3, 

dadurch gekennzelchnet. daB der Werteumfang der Filterdichte M vor ihrer anschlieBenden Veiwendung als 
Prddikttonsdichte (tj^i) reduziert wind. 
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Dichtenreduktion 



p(r) = Sw,p<'>(r) 



P(r) = lw..p<'>(f) 



FIG 6 



17 



This Page is Inserted by IFW Indexing and Scanning 
Operations and is not part of the Official Record 

BEST AVAILABLE IMAGES 

Defective images within this document are accurate representations of the original 
documents submitted by the applicant. 

Defects in the images include but are not limited to the items checked: 

□ black borders 

□ image cut off at top, bottom or sides 
13 faded text or drawing 
□Burred or illegible text or drawing 

□ skewed/slanted images 

□ color or black and white photographs 

□ gray scale documents 

GJ lines or MARKS ON ORIGINAL DOCUMENT 

^ REFERENCE(S) OR EXHIBIT(S) SUBMITTED ARE POOR QUALITY 

□ OTHER: 

IMAGES ARE BEST AVAILABLE COPY. 
As rescanning these documents will not correct the image 
problems checked, please do not report these problems to 
the IFW Image Problem Mailbox. 



